/******************** (C) COPYRIGHT 2008 STMicroelectronics ********************
* File Name          : ili2302lcd.c
* Author             : Cache modify on MCD Application Team
* Version            : V2.0
* Date               : 03/20/2009
* Description        : This file includes the LCD driver for AM-240320L8TNQW00H
*                     (LCD_ILI9320) Liquid Crystal Display Module of STM3210E-EVAL
*                      board.
********************************************************************************
* THE PRESENT FIRMWARE WHICH IS FOR GUIDANCE ONLY AIMS AT PROVIDING CUSTOMERS
* WITH CODING INFORMATION REGARDING THEIR PRODUCTS IN ORDER FOR THEM TO SAVE TIME.
* AS A RESULT, STMICROELECTRONICS SHALL NOT BE HELD LIABLE FOR ANY DIRECT,
* INDIRECT OR CONSEQUENTIAL DAMAGES WITH RESPECT TO ANY CLAIMS ARISING FROM THE
* CONTENT OF SUCH FIRMWARE AND/OR THE USE MADE BY CUSTOMERS OF THE CODING
* INFORMATION CONTAINED HEREIN IN CONNECTION WITH THEIR PRODUCTS.
*******************************************************************************/

/* Includes ------------------------------------------------------------------*/
#include "TFTlcdB505.h"
#include "fonts.h"


/** @addtogroup Utilities
  * @{
  */

/** @addtogroup STM32_EVAL
  * @{
  */

/** @addtogroup STM324xG_EVAL
  * @{
  */

/** @defgroup STM324xG_EVAL_LCD
  * @brief This file includes the LCD driver for AM-240320L8TNQW00H (LCD_ILI9320)
  *        and AM240320D5TOQW01H (LCD_ILI9325) Liquid Crystal Display Modules
  *        of STM324xG_EVAL board.
  * @{
  */

/** @defgroup STM324xG_EVAL_LCD_Private_TypesDefinitions
  * @{
  */
typedef struct
{
    __IO uint16_t LCD_REG;
    __IO uint16_t LCD_RAM;
} LCD_TypeDef;
/**
  * @}
  */


/** @defgroup STM324xG_EVAL_LCD_Private_Defines
  * @{
  */
/* Note: LCD /CS is NE3 - Bank 3 of NOR/SRAM Bank 1~4 */
#define LCD_BASE           ((uint32_t)(0x60000000 | 0x08000000))
#define LCD                ((LCD_TypeDef *) LCD_BASE)
#define MAX_POLY_CORNERS   200
#define POLY_Y(Z)          ((int32_t)((Points + Z)->X))
#define POLY_X(Z)          ((int32_t)((Points + Z)->Y))
#define LCD_HX8347D        0x0047
/**
  * @}
  */
__IO uint32_t lcdid = 0;
/** @defgroup STM324xG_EVAL_LCD_Private_Macros
  * @{
  */
#define ABS(X)  ((X) > 0 ? (X) : -(X))
/**
  * @}
  */

/** @defgroup STM324xG_EVAL_LCD_Private_Variables
  * @{
  */
static sFONT *LCD_Currentfonts;

/* Global variables to set the written text color */
static __IO uint16_t TextColor = 0x0000, BackColor = 0xFFFF;

/**
  * @}
  */


/** @defgroup STM324xG_EVAL_LCD_Private_FunctionPrototypes
  * @{
  */
#ifndef USE_Delay
static void delay(__IO uint32_t nCount);
#endif /* USE_Delay*/
static void PutPixel(int16_t x, int16_t y);
static void LCD_PolyLineRelativeClosed(pPoint Points, uint16_t PointCount, uint16_t Closed);


/**
  * @}
  */


/** @defgroup STM324xG_EVAL_LCD_Private_Functions
  * @{
  */

void  Delay (u32 nCount)
{
    volatile  int  i;


    for (i = 0; i < nCount * 100; i++) {
        ;
    }
}
/**
  * @brief  DeInitializes the LCD.
  * @param  None
  * @retval None
  */
void LCD_DeInit(void)
{
    GPIO_InitTypeDef GPIO_InitStructure;

    /*!< LCD Display Off */
    LCD_DisplayOff();

    /* BANK 3 (of NOR/SRAM Bank 1~4) is disabled */
    FSMC_NORSRAMCmd(FSMC_Bank1_NORSRAM3, ENABLE);

    /*!< LCD_SPI DeInit */
    FSMC_NORSRAMDeInit(FSMC_Bank1_NORSRAM3);

    /*-- GPIO Configuration ------------------------------------------------------*/
    /* SRAM Data lines configuration */
    GPIO_InitStructure.GPIO_Pin = GPIO_Pin_0 | GPIO_Pin_1 | GPIO_Pin_8 | GPIO_Pin_9 |
                                  GPIO_Pin_10 | GPIO_Pin_14 | GPIO_Pin_15;
    GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN;
    GPIO_InitStructure.GPIO_PuPd  = GPIO_PuPd_NOPULL;
    GPIO_Init(GPIOD, &GPIO_InitStructure);

    GPIO_PinAFConfig(GPIOD, GPIO_PinSource0, GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOD, GPIO_PinSource1, GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOD, GPIO_PinSource8, GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOD, GPIO_PinSource9, GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOD, GPIO_PinSource10, GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOD, GPIO_PinSource14, GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOD, GPIO_PinSource15, GPIO_AF_MCO);


    GPIO_InitStructure.GPIO_Pin = GPIO_Pin_7 | GPIO_Pin_8 | GPIO_Pin_9 | GPIO_Pin_10 |
                                  GPIO_Pin_11 | GPIO_Pin_12 | GPIO_Pin_13 | GPIO_Pin_14 |
                                  GPIO_Pin_15;

    GPIO_Init(GPIOE, &GPIO_InitStructure);

    GPIO_PinAFConfig(GPIOE, GPIO_PinSource7 , GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOE, GPIO_PinSource8 , GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOE, GPIO_PinSource9 , GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOE, GPIO_PinSource10 , GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOE, GPIO_PinSource11 , GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOE, GPIO_PinSource12 , GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOE, GPIO_PinSource13 , GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOE, GPIO_PinSource14 , GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOE, GPIO_PinSource15 , GPIO_AF_MCO);

    /* SRAM Address lines configuration */
    GPIO_InitStructure.GPIO_Pin = GPIO_Pin_0 | GPIO_Pin_1 | GPIO_Pin_2 | GPIO_Pin_3 |
                                  GPIO_Pin_4 | GPIO_Pin_5 | GPIO_Pin_12 | GPIO_Pin_13 |
                                  GPIO_Pin_14 | GPIO_Pin_15;
    GPIO_Init(GPIOF, &GPIO_InitStructure);
    GPIO_PinAFConfig(GPIOF,GPIO_PinSource0, GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOF,GPIO_PinSource1, GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOF,GPIO_PinSource2, GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOF,GPIO_PinSource3, GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOF,GPIO_PinSource4, GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOF,GPIO_PinSource5, GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOF,GPIO_PinSource12, GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOF,GPIO_PinSource13, GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOF,GPIO_PinSource14, GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOF,GPIO_PinSource15, GPIO_AF_MCO);


    GPIO_InitStructure.GPIO_Pin = GPIO_Pin_0 | GPIO_Pin_1 | GPIO_Pin_2 | GPIO_Pin_3 |
                                  GPIO_Pin_4 | GPIO_Pin_5;

    GPIO_Init(GPIOG, &GPIO_InitStructure);

    GPIO_PinAFConfig(GPIOG,GPIO_PinSource0, GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOG,GPIO_PinSource1, GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOG,GPIO_PinSource2, GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOG,GPIO_PinSource3, GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOG,GPIO_PinSource4, GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOG,GPIO_PinSource5, GPIO_AF_MCO);

    GPIO_InitStructure.GPIO_Pin = GPIO_Pin_11 | GPIO_Pin_12 | GPIO_Pin_13;

    GPIO_Init(GPIOD, &GPIO_InitStructure);

    GPIO_PinAFConfig(GPIOD,GPIO_PinSource11, GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOD,GPIO_PinSource12, GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOD,GPIO_PinSource13, GPIO_AF_MCO);

    /* NOE and NWE configuration */
    GPIO_InitStructure.GPIO_Pin = GPIO_Pin_4 |GPIO_Pin_5;

    GPIO_Init(GPIOD, &GPIO_InitStructure);
    GPIO_PinAFConfig(GPIOD,GPIO_PinSource4, GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOD,GPIO_PinSource5, GPIO_AF_MCO);

    /* NE3 configuration */
    GPIO_InitStructure.GPIO_Pin = GPIO_Pin_10;

    GPIO_Init(GPIOG, &GPIO_InitStructure);
    GPIO_PinAFConfig(GPIOG, GPIO_PinSource12, GPIO_AF_MCO);

    /* NBL0, NBL1 configuration */
    GPIO_InitStructure.GPIO_Pin = GPIO_Pin_0 | GPIO_Pin_1;
    GPIO_Init(GPIOE, &GPIO_InitStructure);

    GPIO_PinAFConfig(GPIOE,GPIO_PinSource0, GPIO_AF_MCO);
    GPIO_PinAFConfig(GPIOE,GPIO_PinSource1, GPIO_AF_MCO);
}

/**
  * @brief  Initializes the LCD.
  * @param  None
  * @retval None
  */
void STM3210E_LCD_Init(void)
{
// __IO uint32_t lcdid = 0;

    /* Configure the LCD Control pins --------------------------------------------*/
    LCD_CtrlLinesConfig();

    /* Configure the FSMC Parallel interface -------------------------------------*/
    LCD_FSMCConfig();

    _delay_(5); /* delay 50 ms */

    /* Read the LCD ID */
    lcdid = LCD_ReadReg(0x00);
    if(lcdid == LCD_HX8347D)
    {
        /* Driving ability setting */
        LCD_WriteReg(LCD_REG_234, 0x00);
        LCD_WriteReg(LCD_REG_235, 0x20);
        LCD_WriteReg(LCD_REG_236, 0x0C);
        LCD_WriteReg(LCD_REG_237, 0xC4);
        LCD_WriteReg(LCD_REG_232, 0x40);
        LCD_WriteReg(LCD_REG_233, 0x38);
        LCD_WriteReg(LCD_REG_241, 0x01); /* RGB 18-bit interface ;0x0110 */
        LCD_WriteReg(LCD_REG_242, 0x10);
        LCD_WriteReg(LCD_REG_39, 0xA3);

        /* Adjust the Gamma Curve */
        LCD_WriteReg(LCD_REG_64, 0x01);
        LCD_WriteReg(LCD_REG_65, 0x00);
        LCD_WriteReg(LCD_REG_66, 0x00);
        LCD_WriteReg(LCD_REG_67, 0x10);
        LCD_WriteReg(LCD_REG_68, 0x0E);
        LCD_WriteReg(LCD_REG_69, 0x24);
        LCD_WriteReg(LCD_REG_70, 0x04);
        LCD_WriteReg(LCD_REG_71, 0x50);
        LCD_WriteReg(LCD_REG_72, 0x02);
        LCD_WriteReg(LCD_REG_73, 0x13);
        LCD_WriteReg(LCD_REG_74, 0x19);
        LCD_WriteReg(LCD_REG_75, 0x19);
        LCD_WriteReg(LCD_REG_76, 0x16);

        LCD_WriteReg(LCD_REG_80, 0x1B);
        LCD_WriteReg(LCD_REG_81, 0x31);
        LCD_WriteReg(LCD_REG_82, 0x2F);
        LCD_WriteReg(LCD_REG_83, 0x3F);
        LCD_WriteReg(LCD_REG_84, 0x3F);
        LCD_WriteReg(LCD_REG_85, 0x3E);
        LCD_WriteReg(LCD_REG_86, 0x2F);
        LCD_WriteReg(LCD_REG_87, 0x7B);
        LCD_WriteReg(LCD_REG_88, 0x09);
        LCD_WriteReg(LCD_REG_89, 0x06);
        LCD_WriteReg(LCD_REG_90, 0x06);
        LCD_WriteReg(LCD_REG_91, 0x0C);
        LCD_WriteReg(LCD_REG_92, 0x1D);
        LCD_WriteReg(LCD_REG_93, 0xCC);

        /* Power voltage setting */
        LCD_WriteReg(LCD_REG_27, 0x1B);
        LCD_WriteReg(LCD_REG_26, 0x01);
        LCD_WriteReg(LCD_REG_36, 0x2F);
        LCD_WriteReg(LCD_REG_37, 0x57);
        /*****VCOM offset ****/
        LCD_WriteReg(LCD_REG_35, 0x86);

        /* Power on setting */
        LCD_WriteReg(LCD_REG_24, 0x36); /* Display frame rate:75Hz(2.85MHz X 117%) */
        LCD_WriteReg(LCD_REG_25, 0x01); /* Internal oscillator start to oscillate */
        LCD_WriteReg(LCD_REG_1,0x00);
        LCD_WriteReg(LCD_REG_31, 0x88); /* Step-up Circuit 1 on,open abnormal power-off monitor */
        _delay_(6);
        LCD_WriteReg(LCD_REG_31, 0x80); /* Step-up Circuit 1 off */
        _delay_(6);
        LCD_WriteReg(LCD_REG_31, 0x90); /* VCOML voltage can output to negative voltage,
                                (1.0V ~ VCL+0.5V) */
        _delay_(6);
        LCD_WriteReg(LCD_REG_31, 0xD0); /* Step-up Circuit 2 on */
        _delay_(6);

        LCD_WriteReg(LCD_REG_23, 0x05);  /* COLMOD control */

        /* Set GRAM Area - Partial Display Control */
        LCD_WriteReg(LCD_REG_1, 0x00); /* Scroll off */

        LCD_WriteReg(LCD_REG_2, 0x00);
        LCD_WriteReg(LCD_REG_3, 0x00);
        LCD_WriteReg(LCD_REG_4, 0x01); /* X,Y swap */
        LCD_WriteReg(LCD_REG_5, 0x3F); /* X,Y swap */

        LCD_WriteReg(LCD_REG_6, 0x00);
        LCD_WriteReg(LCD_REG_7, 0x00);
        LCD_WriteReg(LCD_REG_8, 0x00); /* X,Y swap */
        LCD_WriteReg(LCD_REG_9, 0xEF); /* X,Y swap */

        /* Memory access control */
        /* bit7 controls left,right swap(X) */
        /* bit6 controls up,down swap(Y) */
        /* bit5 controls X,Y swap */
        LCD_WriteReg(LCD_REG_22, 0x28);

        /* SET PANEL */
        LCD_WriteReg(LCD_REG_54, 0x00); /* Panel characteristic control */
        LCD_WriteReg(LCD_REG_54, 0x04); /* Panel characteristic control: gate driver shift reverse[work] */
        LCD_WriteReg(LCD_REG_40, 0x38); /* Display control3: source output->PT(0,0) */
        _delay_(20);
        LCD_WriteReg(LCD_REG_40, 0x3C); /* Display control3: source output->Display */
    }
    else
    {
        /* Check if the LCD is SPFD5408B Controller */
        if(LCD_ReadReg(0x00) == 0x5408)
        {
            /* Start Initial Sequence ------------------------------------------------*/
            LCD_WriteReg(LCD_REG_1, 0x0100);  /* Set SS bit */
            LCD_WriteReg(LCD_REG_2, 0x0700);  /* Set 1 line inversion */
            LCD_WriteReg(LCD_REG_3, 0x1030);  /* Set GRAM write direction and BGR=1. */
            LCD_WriteReg(LCD_REG_4, 0x0000);  /* Resize register */
            LCD_WriteReg(LCD_REG_8, 0x0202);  /* Set the back porch and front porch */
            LCD_WriteReg(LCD_REG_9, 0x0000);  /* Set non-display area refresh cycle ISC[3:0] */
            LCD_WriteReg(LCD_REG_10, 0x0000); /* FMARK function */
            LCD_WriteReg(LCD_REG_12, 0x0000); /* RGB 18-bit System interface setting */
            LCD_WriteReg(LCD_REG_13, 0x0000); /* Frame marker Position */
            LCD_WriteReg(LCD_REG_15, 0x0000); /* RGB interface polarity, no impact */
            /* Power On sequence -----------------------------------------------------*/
            LCD_WriteReg(LCD_REG_16, 0x0000); /* SAP, BT[3:0], AP, DSTB, SLP, STB */
            LCD_WriteReg(LCD_REG_17, 0x0000); /* DC1[2:0], DC0[2:0], VC[2:0] */
            LCD_WriteReg(LCD_REG_18, 0x0000); /* VREG1OUT voltage */
            LCD_WriteReg(LCD_REG_19, 0x0000); /* VDV[4:0] for VCOM amplitude */
            _delay_(60);                 /* Dis-charge capacitor power voltage (200ms) */
            LCD_WriteReg(LCD_REG_17, 0x0007);  /* DC1[2:0], DC0[2:0], VC[2:0] */
            _delay_(20);                   /* Delay 50 ms */
            LCD_WriteReg(LCD_REG_16, 0x12B0);  /* SAP, BT[3:0], AP, DSTB, SLP, STB */
            _delay_(20);                  /* Delay 50 ms */
            LCD_WriteReg(LCD_REG_18, 0x01BD);  /* External reference voltage= Vci */
            _delay_(20);
            LCD_WriteReg(LCD_REG_19, 0x1400);  /* VDV[4:0] for VCOM amplitude */
            LCD_WriteReg(LCD_REG_41, 0x000E);  /* VCM[4:0] for VCOMH */
            _delay_(20);                   /* Delay 50 ms */
            LCD_WriteReg(LCD_REG_32, 0x0000); /* GRAM horizontal Address */
            LCD_WriteReg(LCD_REG_33, 0x013F); /* GRAM Vertical Address */
            /* Adjust the Gamma Curve (SPFD5408B)-------------------------------------*/
            LCD_WriteReg(LCD_REG_48, 0x0b0d);
            LCD_WriteReg(LCD_REG_49, 0x1923);
            LCD_WriteReg(LCD_REG_50, 0x1c26);
            LCD_WriteReg(LCD_REG_51, 0x261c);
            LCD_WriteReg(LCD_REG_52, 0x2419);
            LCD_WriteReg(LCD_REG_53, 0x0d0b);
            LCD_WriteReg(LCD_REG_54, 0x1006);
            LCD_WriteReg(LCD_REG_55, 0x0610);
            LCD_WriteReg(LCD_REG_56, 0x0706);
            LCD_WriteReg(LCD_REG_57, 0x0304);
            LCD_WriteReg(LCD_REG_58, 0x0e05);
            LCD_WriteReg(LCD_REG_59, 0x0e01);
            LCD_WriteReg(LCD_REG_60, 0x010e);
            LCD_WriteReg(LCD_REG_61, 0x050e);
            LCD_WriteReg(LCD_REG_62, 0x0403);
            LCD_WriteReg(LCD_REG_63, 0x0607);
            /* Set GRAM area ---------------------------------------------------------*/
            LCD_WriteReg(LCD_REG_80, 0x0000); /* Horizontal GRAM Start Address */
            LCD_WriteReg(LCD_REG_81, 0x00EF); /* Horizontal GRAM End Address */
            LCD_WriteReg(LCD_REG_82, 0x0000); /* Vertical GRAM Start Address */
            LCD_WriteReg(LCD_REG_83, 0x013F); /* Vertical GRAM End Address */
            LCD_WriteReg(LCD_REG_96,  0xA700); /* Gate Scan Line */
            LCD_WriteReg(LCD_REG_97,  0x0001); /* NDL, VLE, REV */
            LCD_WriteReg(LCD_REG_106, 0x0000); /* set scrolling line */
            /* Partial Display Control -----------------------------------------------*/
            LCD_WriteReg(LCD_REG_128, 0x0000);
            LCD_WriteReg(LCD_REG_129, 0x0000);
            LCD_WriteReg(LCD_REG_130, 0x0000);
            LCD_WriteReg(LCD_REG_131, 0x0000);
            LCD_WriteReg(LCD_REG_132, 0x0000);
            LCD_WriteReg(LCD_REG_133, 0x0000);
            /* Panel Control ---------------------------------------------------------*/
            LCD_WriteReg(LCD_REG_144, 0x0010);
            LCD_WriteReg(LCD_REG_146, 0x0000);
            LCD_WriteReg(LCD_REG_147, 0x0003);
            LCD_WriteReg(LCD_REG_149, 0x0110);
            LCD_WriteReg(LCD_REG_151, 0x0000);
            LCD_WriteReg(LCD_REG_152, 0x0000);
            /* Set GRAM write direction and BGR=1
            I/D=01 (Horizontal : increment, Vertical : decrement)
            AM=1 (address is updated in vertical writing direction) */
            LCD_WriteReg(LCD_REG_3, 0x1018);
            LCD_WriteReg(LCD_REG_7, 0x0112); /* 262K color and display ON */
            LCD_SetFont(&LCD_DEFAULT_FONT);
            return;
        }
        /* Start Initial Sequence ----------------------------------------------------*/
        LCD_WriteReg(LCD_REG_229,0x8000); /* Set the internal vcore voltage */
        LCD_WriteReg(LCD_REG_0,  0x0001); /* Start internal OSC. */
        LCD_WriteReg(LCD_REG_1,  0x0100); /* set SS and SM bit */
        LCD_WriteReg(LCD_REG_2,  0x0700); /* set 1 line inversion */
        LCD_WriteReg(LCD_REG_3,  0x1030); /* set GRAM write direction and BGR=1. */
        LCD_WriteReg(LCD_REG_4,  0x0000); /* Resize register */
        LCD_WriteReg(LCD_REG_8,  0x0202); /* set the back porch and front porch */
        LCD_WriteReg(LCD_REG_9,  0x0000); /* set non-display area refresh cycle ISC[3:0] */
        LCD_WriteReg(LCD_REG_10, 0x0000); /* FMARK function */
        LCD_WriteReg(LCD_REG_12, 0x0000); /* RGB interface setting */
        LCD_WriteReg(LCD_REG_13, 0x0000); /* Frame marker Position */
        LCD_WriteReg(LCD_REG_15, 0x0000); /* RGB interface polarity */
        /* Power On sequence ---------------------------------------------------------*/
        LCD_WriteReg(LCD_REG_16, 0x0000); /* SAP, BT[3:0], AP, DSTB, SLP, STB */
        LCD_WriteReg(LCD_REG_17, 0x0000); /* DC1[2:0], DC0[2:0], VC[2:0] */
        LCD_WriteReg(LCD_REG_18, 0x0000); /* VREG1OUT voltage */
        LCD_WriteReg(LCD_REG_19, 0x0000); /* VDV[4:0] for VCOM amplitude */
        _delay_(20);                 /* Dis-charge capacitor power voltage (200ms) */
        LCD_WriteReg(LCD_REG_16, 0x17B0); /* SAP, BT[3:0], AP, DSTB, SLP, STB */
        LCD_WriteReg(LCD_REG_17, 0x0137); /* DC1[2:0], DC0[2:0], VC[2:0] */
        _delay_(20);                  /* Delay 50 ms */
        LCD_WriteReg(LCD_REG_18, 0x0139); /* VREG1OUT voltage */
        _delay_(20);                  /* Delay 50 ms */
        LCD_WriteReg(LCD_REG_19, 0x1d00); /* VDV[4:0] for VCOM amplitude */
        LCD_WriteReg(LCD_REG_41, 0x0013); /* VCM[4:0] for VCOMH */
        _delay_(20);                  /* Delay 50 ms */
        LCD_WriteReg(LCD_REG_32, 0x00ef); /* GRAM horizontal Address */
        LCD_WriteReg(LCD_REG_33, 0x013f); /* GRAM Vertical Address */
        /* Adjust the Gamma Curve ----------------------------------------------------*/
        LCD_WriteReg(LCD_REG_48, 0x0006);
        LCD_WriteReg(LCD_REG_49, 0x0101);
        LCD_WriteReg(LCD_REG_50, 0x0003);
        LCD_WriteReg(LCD_REG_53, 0x0106);
        LCD_WriteReg(LCD_REG_54, 0x0b02);
        LCD_WriteReg(LCD_REG_55, 0x0302);
        LCD_WriteReg(LCD_REG_56, 0x0707);
        LCD_WriteReg(LCD_REG_57, 0x0007);
        LCD_WriteReg(LCD_REG_60, 0x0600);
        LCD_WriteReg(LCD_REG_61, 0x020b);

        /* Set GRAM area -------------------------------------------------------------*/
        LCD_WriteReg(LCD_REG_80, 0x0000); /* Horizontal GRAM Start Address */
        LCD_WriteReg(LCD_REG_81, 0x00EF); /* Horizontal GRAM End Address */
        LCD_WriteReg(LCD_REG_82, 0x0000); /* Vertical GRAM Start Address */
        LCD_WriteReg(LCD_REG_83, 0x013F); /* Vertical GRAM End Address */
        LCD_WriteReg(LCD_REG_96,  0x2700); /* Gate Scan Line */
        LCD_WriteReg(LCD_REG_97,  0x0001); /* NDL,VLE, REV */
        LCD_WriteReg(LCD_REG_106, 0x0000); /* set scrolling line */
        /* Partial Display Control ---------------------------------------------------*/
        LCD_WriteReg(LCD_REG_128, 0x0000);
        LCD_WriteReg(LCD_REG_129, 0x0000);
        LCD_WriteReg(LCD_REG_130, 0x0000);
        LCD_WriteReg(LCD_REG_131, 0x0000);
        LCD_WriteReg(LCD_REG_132, 0x0000);
        LCD_WriteReg(LCD_REG_133, 0x0000);
        /* Panel Control -------------------------------------------------------------*/
        LCD_WriteReg(LCD_REG_144, 0x0010);
        LCD_WriteReg(LCD_REG_146, 0x0000);
        LCD_WriteReg(LCD_REG_147, 0x0003);
        LCD_WriteReg(LCD_REG_149, 0x0110);
        LCD_WriteReg(LCD_REG_151, 0x0000);
        LCD_WriteReg(LCD_REG_152, 0x0000);
        /* Set GRAM write direction and BGR = 1 */
        /* I/D=01 (Horizontal : increment, Vertical : decrement) */
        /* AM=1 (address is updated in vertical writing direction) */
        //LCD_WriteReg(LCD_REG_3, 0x1018);
        LCD_WriteReg(LCD_REG_3, 0x1038);
        LCD_WriteReg(LCD_REG_7, 0x0173); /* 262K color and display ON */
    }
    /* Check if the LCD is ILI9320 Controller */
//  if(lcdid == 0x9320)
//  {
//    /* Start Initial Sequence ------------------------------------------------*/
//    LCD_WriteReg(LCD_REG_229,0x8000); /* Set the internal vcore voltage */
//    LCD_WriteReg(LCD_REG_0,  0x0001); /* Start internal OSC. */
//    LCD_WriteReg(LCD_REG_1,  0x0100); /* set SS and SM bit */
//    LCD_WriteReg(LCD_REG_2,  0x0700); /* set 1 line inversion */
//    LCD_WriteReg(LCD_REG_3,  0x1030); /* set GRAM write direction and BGR=1. */
//    LCD_WriteReg(LCD_REG_4,  0x0000); /* Resize register */
//    LCD_WriteReg(LCD_REG_8,  0x0202); /* set the back porch and front porch */
//    LCD_WriteReg(LCD_REG_9,  0x0000); /* set non-display area refresh cycle ISC[3:0] */
//    LCD_WriteReg(LCD_REG_10, 0x0000); /* FMARK function */
//    LCD_WriteReg(LCD_REG_12, 0x0000); /* RGB interface setting */
//    LCD_WriteReg(LCD_REG_13, 0x0000); /* Frame marker Position */
//    LCD_WriteReg(LCD_REG_15, 0x0000); /* RGB interface polarity */

//    /* Power On sequence -----------------------------------------------------*/
//    LCD_WriteReg(LCD_REG_16, 0x0000); /* SAP, BT[3:0], AP, DSTB, SLP, STB */
//    LCD_WriteReg(LCD_REG_17, 0x0000); /* DC1[2:0], DC0[2:0], VC[2:0] */
//    LCD_WriteReg(LCD_REG_18, 0x0000); /* VREG1OUT voltage */
//    LCD_WriteReg(LCD_REG_19, 0x0000); /* VDV[4:0] for VCOM amplitude */
//    _delay_(20);                 /* Dis-charge capacitor power voltage (200ms) */
//    LCD_WriteReg(LCD_REG_16, 0x17B0); /* SAP, BT[3:0], AP, DSTB, SLP, STB */
//    LCD_WriteReg(LCD_REG_17, 0x0137); /* DC1[2:0], DC0[2:0], VC[2:0] */
//    _delay_(5);                  /* Delay 50 ms */
//    LCD_WriteReg(LCD_REG_18, 0x0139); /* VREG1OUT voltage */
//    _delay_(5);                  /* Delay 50 ms */
//    LCD_WriteReg(LCD_REG_19, 0x1d00); /* VDV[4:0] for VCOM amplitude */
//    LCD_WriteReg(LCD_REG_41, 0x0013); /* VCM[4:0] for VCOMH */
//    _delay_(5);                  /* Delay 50 ms */
//    LCD_WriteReg(LCD_REG_32, 0x0000); /* GRAM horizontal Address */
//    LCD_WriteReg(LCD_REG_33, 0x0000); /* GRAM Vertical Address */

//    /* Adjust the Gamma Curve ------------------------------------------------*/
//    LCD_WriteReg(LCD_REG_48, 0x0006);
//    LCD_WriteReg(LCD_REG_49, 0x0101);
//    LCD_WriteReg(LCD_REG_50, 0x0003);
//    LCD_WriteReg(LCD_REG_53, 0x0106);
//    LCD_WriteReg(LCD_REG_54, 0x0b02);
//    LCD_WriteReg(LCD_REG_55, 0x0302);
//    LCD_WriteReg(LCD_REG_56, 0x0707);
//    LCD_WriteReg(LCD_REG_57, 0x0007);
//    LCD_WriteReg(LCD_REG_60, 0x0600);
//    LCD_WriteReg(LCD_REG_61, 0x020b);
//
//    /* Set GRAM area ---------------------------------------------------------*/
//    LCD_WriteReg(LCD_REG_80, 0x0000); /* Horizontal GRAM Start Address */
//    LCD_WriteReg(LCD_REG_81, 0x00EF); /* Horizontal GRAM End Address */
//    LCD_WriteReg(LCD_REG_82, 0x0000); /* Vertical GRAM Start Address */
//    LCD_WriteReg(LCD_REG_83, 0x013F); /* Vertical GRAM End Address */
//    LCD_WriteReg(LCD_REG_96,  0x2700); /* Gate Scan Line */
//    LCD_WriteReg(LCD_REG_97,  0x0001); /* NDL,VLE, REV */
//    LCD_WriteReg(LCD_REG_106, 0x0000); /* set scrolling line */

//    /* Partial Display Control -----------------------------------------------*/
//    LCD_WriteReg(LCD_REG_128, 0x0000);
//    LCD_WriteReg(LCD_REG_129, 0x0000);
//    LCD_WriteReg(LCD_REG_130, 0x0000);
//    LCD_WriteReg(LCD_REG_131, 0x0000);
//    LCD_WriteReg(LCD_REG_132, 0x0000);
//    LCD_WriteReg(LCD_REG_133, 0x0000);

//    /* Panel Control ---------------------------------------------------------*/
//    LCD_WriteReg(LCD_REG_144, 0x0010);
//    LCD_WriteReg(LCD_REG_146, 0x0000);
//    LCD_WriteReg(LCD_REG_147, 0x0003);
//    LCD_WriteReg(LCD_REG_149, 0x0110);
//    LCD_WriteReg(LCD_REG_151, 0x0000);
//    LCD_WriteReg(LCD_REG_152, 0x0000);

//    /* Set GRAM write direction and BGR = 1 */
//    /* I/D=01 (Horizontal : increment, Vertical : decrement) */
//    /* AM=1 (address is updated in vertical writing direction) */
//    LCD_WriteReg(LCD_REG_3, 0x1018);

//    LCD_WriteReg(LCD_REG_7, 0x0173); /* 262K color and display ON */
//  }
//  else if(lcdid == 0x9325) /* Check if the LCD is ILI9325 Controller */
//  {
//    /* Start Initial Sequence ------------------------------------------------*/
//    LCD_WriteReg(LCD_REG_0, 0x0001); /* Start internal OSC. */
//    LCD_WriteReg(LCD_REG_1, 0x0100); /* Set SS and SM bit */
//    LCD_WriteReg(LCD_REG_2, 0x0700); /* Set 1 line inversion */
//    LCD_WriteReg(LCD_REG_3, 0x1018); /* Set GRAM write direction and BGR=1. */
//    LCD_WriteReg(LCD_REG_4, 0x0000); /* Resize register */
//    LCD_WriteReg(LCD_REG_8, 0x0202); /* Set the back porch and front porch */
//    LCD_WriteReg(LCD_REG_9, 0x0000); /* Set non-display area refresh cycle ISC[3:0] */
//    LCD_WriteReg(LCD_REG_10, 0x0000); /* FMARK function */
//    LCD_WriteReg(LCD_REG_12, 0x0000); /* RGB interface setting */
//    LCD_WriteReg(LCD_REG_13, 0x0000); /* Frame marker Position */
//    LCD_WriteReg(LCD_REG_15, 0x0000); /* RGB interface polarity */

//    /* Power On sequence -----------------------------------------------------*/
//    LCD_WriteReg(LCD_REG_16, 0x0000); /* SAP, BT[3:0], AP, DSTB, SLP, STB */
//    LCD_WriteReg(LCD_REG_17, 0x0000); /* DC1[2:0], DC0[2:0], VC[2:0] */
//    LCD_WriteReg(LCD_REG_18, 0x0000); /* VREG1OUT voltage */
//    LCD_WriteReg(LCD_REG_19, 0x0000); /* VDV[4:0] for VCOM amplitude */
//    _delay_(20);                      /* Dis-charge capacitor power voltage (200ms) */
//    LCD_WriteReg(LCD_REG_16, 0x17B0); /* SAP, BT[3:0], AP, DSTB, SLP, STB */
//    LCD_WriteReg(LCD_REG_17, 0x0137); /* DC1[2:0], DC0[2:0], VC[2:0] */
//    _delay_(5);                       /* Delay 50 ms */
//    LCD_WriteReg(LCD_REG_18, 0x0139); /* VREG1OUT voltage */
//    _delay_(5);                       /* Delay 50 ms */
//    LCD_WriteReg(LCD_REG_19, 0x1d00); /* VDV[4:0] for VCOM amplitude */
//    LCD_WriteReg(LCD_REG_41, 0x0013); /* VCM[4:0] for VCOMH */
//    _delay_(5);                       /* Delay 50 ms */
//    LCD_WriteReg(LCD_REG_32, 0x0000); /* GRAM horizontal Address */
//    LCD_WriteReg(LCD_REG_33, 0x0000); /* GRAM Vertical Address */

//    /* Adjust the Gamma Curve (ILI9325)---------------------------------------*/
//    LCD_WriteReg(LCD_REG_48, 0x0007);
//    LCD_WriteReg(LCD_REG_49, 0x0302);
//    LCD_WriteReg(LCD_REG_50, 0x0105);
//    LCD_WriteReg(LCD_REG_53, 0x0206);
//    LCD_WriteReg(LCD_REG_54, 0x0808);
//    LCD_WriteReg(LCD_REG_55, 0x0206);
//    LCD_WriteReg(LCD_REG_56, 0x0504);
//    LCD_WriteReg(LCD_REG_57, 0x0007);
//    LCD_WriteReg(LCD_REG_60, 0x0105);
//    LCD_WriteReg(LCD_REG_61, 0x0808);

//    /* Set GRAM area ---------------------------------------------------------*/
//    LCD_WriteReg(LCD_REG_80, 0x0000); /* Horizontal GRAM Start Address */
//    LCD_WriteReg(LCD_REG_81, 0x00EF); /* Horizontal GRAM End Address */
//    LCD_WriteReg(LCD_REG_82, 0x0000); /* Vertical GRAM Start Address */
//    LCD_WriteReg(LCD_REG_83, 0x013F); /* Vertical GRAM End Address */

//    LCD_WriteReg(LCD_REG_96,  0xA700); /* Gate Scan Line(GS=1, scan direction is G320~G1) */
//    LCD_WriteReg(LCD_REG_97,  0x0001); /* NDL,VLE, REV */
//    LCD_WriteReg(LCD_REG_106, 0x0000); /* set scrolling line */

//    /* Partial Display Control -----------------------------------------------*/
//    LCD_WriteReg(LCD_REG_128, 0x0000);
//    LCD_WriteReg(LCD_REG_129, 0x0000);
//    LCD_WriteReg(LCD_REG_130, 0x0000);
//    LCD_WriteReg(LCD_REG_131, 0x0000);
//    LCD_WriteReg(LCD_REG_132, 0x0000);
//    LCD_WriteReg(LCD_REG_133, 0x0000);

//    /* Panel Control ---------------------------------------------------------*/
//    LCD_WriteReg(LCD_REG_144, 0x0010);
//    LCD_WriteReg(LCD_REG_146, 0x0000);
//    LCD_WriteReg(LCD_REG_147, 0x0003);
//    LCD_WriteReg(LCD_REG_149, 0x0110);
//    LCD_WriteReg(LCD_REG_151, 0x0000);
//    LCD_WriteReg(LCD_REG_152, 0x0000);

//    /* set GRAM write direction and BGR = 1 */
//    /* I/D=00 (Horizontal : increment, Vertical : decrement) */
//    /* AM=1 (address is updated in vertical writing direction) */
//    LCD_WriteReg(LCD_REG_3, 0x1018);

//    LCD_WriteReg(LCD_REG_7, 0x0133); /* 262K color and display ON */
//  }
    LCD_SetFont(&LCD_DEFAULT_FONT);
}

/**
  * @brief  Sets the LCD Text and Background colors.
  * @param  _TextColor: specifies the Text Color.
  * @param  _BackColor: specifies the Background Color.
  * @retval None
  */
void LCD_SetColors(__IO uint16_t _TextColor, __IO uint16_t _BackColor)
{
    TextColor = _TextColor;
    BackColor = _BackColor;
}

/**
  * @brief  Gets the LCD Text and Background colors.
  * @param  _TextColor: pointer to the variable that will contain the Text
            Color.
  * @param  _BackColor: pointer to the variable that will contain the Background
            Color.
  * @retval None
  */
void LCD_GetColors(__IO uint16_t *_TextColor, __IO uint16_t *_BackColor)
{
    *_TextColor = TextColor;
    *_BackColor = BackColor;
}

/**
  * @brief  Sets the Text color.
  * @param  Color: specifies the Text color code RGB(5-6-5).
  * @retval None
  */
void LCD_SetTextColor(__IO uint16_t Color)
{
    TextColor = Color;
}


/**
  * @brief  Sets the Background color.
  * @param  Color: specifies the Background color code RGB(5-6-5).
  * @retval None
  */
void LCD_SetBackColor(__IO uint16_t Color)
{
    BackColor = Color;
}

/**
  * @brief  Sets the Text Font.
  * @param  fonts: specifies the font to be used.
  * @retval None
  */
void LCD_SetFont(sFONT *fonts)
{
    LCD_Currentfonts = fonts;
}

/**
  * @brief  Gets the Text Font.
  * @param  None.
  * @retval the used font.
  */
sFONT *LCD_GetFont(void)
{
    return LCD_Currentfonts;
}

/**
  * @brief  Clears the selected line.
  * @param  Line: the Line to be cleared.
  *   This parameter can be one of the following values:
  *     @arg Linex: where x can be 0..n
  * @retval None
  */
void LCD_ClearLine(uint16_t Line)
{
    uint16_t refcolumn = LCD_PIXEL_WIDTH - 1;
    /* Send the string character by character on lCD */
    while (((refcolumn + 1)& 0xFFFF) >= LCD_Currentfonts->Width)
    {
        /* Display one character on LCD */
        LCD_DisplayChar(Line, refcolumn, ' ');
        /* Decrement the column position by 16 */
        refcolumn -= LCD_Currentfonts->Width;
    }
}

/**
  * @brief  Clears the hole LCD.
  * @param  Color: the color of the background.
  * @retval None
  */
void LCD_Clear(uint16_t Color)
{
    uint32_t index = 0;

    LCD_SetCursor(0x00, 0x013F);
    LCD_WriteRAM_Prepare(); /* Prepare to write GRAM */
    for(index = 0; index < 76800; index++)
    {
        LCD->LCD_RAM = Color;
    }
}

/**
  * @brief  Sets the cursor position.
  * @param  Xpos: specifies the X position.
  * @param  Ypos: specifies the Y position.
  * @retval None
  */
void LCD_SetCursor(uint16_t Xpos, uint16_t Ypos)
{
    if(lcdid == LCD_HX8347D)
    {
        LCD_WriteReg(LCD_REG_2, Ypos >> 8);
        LCD_WriteReg(LCD_REG_3, Ypos & 0xFF);
        LCD_WriteReg(LCD_REG_6, 0x00);
        LCD_WriteReg(LCD_REG_7, Xpos);
    }
    else
    {
        LCD_WriteReg(LCD_REG_32, Xpos);
        LCD_WriteReg(LCD_REG_33, Ypos);
    }
}
/**
  * @brief  Draws a character on LCD.
  * @param  Xpos: the Line where to display the character shape.
  * @param  Ypos: start column address.
  * @param  c: pointer to the character data.
  * @retval None
  */
//void LCD_DrawChar(uint16_t Xpos, uint16_t Ypos, const uint16_t *c)
//{
//  uint32_t index = 0, i = 0;
//  uint16_t  Xaddress = 0;
//  Xaddress = Xpos;
//
//  LCD_SetCursor(Xaddress, Ypos);
//
//  for(index = 0; index < LCD_Currentfonts->Height; index++)
//  {
//    LCD_WriteRAM_Prepare(); /* Prepare to write GRAM */
//    for(i = 0; i < LCD_Currentfonts->Width; i++)
//    {
//
//      if((((c[index] & ((0x80 << ((LCD_Currentfonts->Width / 12 ) * 8 ) ) >> i)) == 0x00) &&(LCD_Currentfonts->Width <= 12))||
//        (((c[index] & (0x1 << i)) == 0x00)&&(LCD_Currentfonts->Width > 12 )))

//      {
//        LCD_WriteRAM(BackColor);
//      }
//      else
//      {
//        LCD_WriteRAM(TextColor);
//      }
//    }
//    Xaddress++;
//    LCD_SetCursor(Xaddress, Ypos);
//  }
//}
void LCD_DrawChar(uint16_t Xpos, uint16_t Ypos, const uint16_t *c)
{
    uint32_t index = 0, i = 0;
    uint8_t Xaddress = 0;

    Xaddress = Xpos;

    LCD_SetCursor(Xaddress, Ypos);

    for(index = 0; index < LCD_Currentfonts->Height; index++)
    {
        LCD_WriteRAM_Prepare(); /* Prepare to write GRAM */
        for(i = 0; i < LCD_Currentfonts->Width; i++)
        {
            if((((c[index] & ((0x80 << ((LCD_Currentfonts->Width / 12 ) * 8 ) ) >> i)) == 0x00) &&(LCD_Currentfonts->Width <= 12))||
                    (((c[index] & (0x1 << i)) == 0x00)&&(LCD_Currentfonts->Width > 12 )))
            {
                LCD_WriteRAM(BackColor);
            }
            else
            {
                LCD_WriteRAM(TextColor);
            }
        }
        Xaddress--;
        LCD_SetCursor(Xaddress, Ypos);
    }
}
/**
  * @brief  Displays one character (16dots width, 24dots height).
  * @param  Line: the Line where to display the character shape .
  *   This parameter can be one of the following values:
  *     @arg Linex: where x can be 0..9
  * @param  Column: start column address.
  * @param  Ascii: character ascii code, must be between 0x20 and 0x7E.
  * @retval None
  */
void LCD_DisplayChar(uint16_t Line, uint16_t Column, uint8_t Ascii)
{
    Ascii -= 32;
    LCD_DrawChar(Line, Column, &LCD_Currentfonts->table[Ascii * LCD_Currentfonts->Height]);
}
//void LCD_DisplayChar(uint16_t Line, uint16_t Column, uint8_t Ascii)
//{
//  Ascii -= 32;
//  if(lcdid == LCD_HX8347D)
//  {
//    Column = 319 - Column;
//  }
//  else
//  {
//    Column = Column;
//  }
//
//  LCD_DrawChar(Line, Column, &LCD_Currentfonts->table[Ascii * LCD_Currentfonts->Height]);
//}
/**
  * @brief  Displays a maximum of 20 char on the LCD.
  * @param  Line: the Line where to display the character shape .
  *   This parameter can be one of the following values:
  *     @arg Linex: where x can be 0..9
  * @param  *ptr: pointer to string to display on LCD.
  * @retval None
  */
//void LCD_DisplayStringLine(uint16_t Line, uint8_t *ptr)
//{
//  uint16_t refcolumn = LCD_PIXEL_WIDTH - 1;

//  /* Send the string character by character on lCD */
//  while ((*ptr != 0) & (((refcolumn + 1) & 0xFFFF) >= LCD_Currentfonts->Width))
//  {
//    /* Display one character on LCD */
//    LCD_DisplayChar(Line, refcolumn, *ptr);
//    /* Decrement the column position by 16 */
//    refcolumn -= LCD_Currentfonts->Width;
//    /* Point on the next character */
//    ptr++;
//  }
//}
void LCD_DisplayStringLine(uint16_t Line, uint8_t *ptr)
{
    uint32_t i = 0;
    uint16_t refcolumn = 0;
    int16_t deltacolumn;

    //refcolumn = 319;
    deltacolumn = LCD_Currentfonts->Width;

    /* Send the string character by character on lCD */
    while ((*ptr != 0) & (i < 320/LCD_Currentfonts->Width))
    {
        /* Display one character on LCD */
        LCD_DisplayChar(Line, refcolumn, *ptr);
        /* Decrement the column position by deltacolumn(16 or -16 for HX8347G) */
        refcolumn += deltacolumn;
        /* Point on the next character */
        ptr++;
        /* Increment the character counter */
        i++;
    }
}

/**
  * @brief  Sets a display window
  * @param  Xpos: specifies the X bottom left position.
  * @param  Ypos: specifies the Y bottom left position.
  * @param  Height: display window height.
  * @param  Width: display window width.
  * @retval None
  */
void LCD_SetDisplayWindow(uint16_t Xpos, uint16_t Ypos, uint8_t Height, uint16_t Width)
{
    /* Horizontal GRAM Start Address */
    if(Xpos >= Height)
    {
        LCD_WriteReg(LCD_REG_80, (Xpos - Height + 1));
    }
    else
    {
        LCD_WriteReg(LCD_REG_80, 0);
    }
    /* Horizontal GRAM End Address */
    LCD_WriteReg(LCD_REG_81, Xpos);
    /* Vertical GRAM Start Address */
    if(Ypos >= Width)
    {
        LCD_WriteReg(LCD_REG_82, (Ypos - Width + 1));
    }
    else
    {
        LCD_WriteReg(LCD_REG_82, 0);
    }
    /* Vertical GRAM End Address */
    LCD_WriteReg(LCD_REG_83, Ypos);
    LCD_SetCursor(Xpos, Ypos);
}

/**
  * @brief  Disables LCD Window mode.
  * @param  None
  * @retval None
  */
void LCD_WindowModeDisable(void)
{
    LCD_SetDisplayWindow(239, 0x13F, 240, 320);
    LCD_WriteReg(LCD_REG_3, 0x1018);
}

/**
  * @brief  Displays a line.
  * @param Xpos: specifies the X position.
  * @param Ypos: specifies the Y position.
  * @param Length: line length.
  * @param Direction: line direction.
  *   This parameter can be one of the following values: Vertical or Horizontal.
  * @retval None
  */
void LCD_DrawLine(uint16_t Xpos, uint16_t Ypos, uint16_t Length, uint8_t Direction)
{
    uint32_t i = 0;

    LCD_SetCursor(Xpos, Ypos);
    if(Direction == LCD_DIR_HORIZONTAL)
    {
        LCD_WriteRAM_Prepare(); /* Prepare to write GRAM */
        for(i = 0; i < Length; i++)
        {
            LCD_WriteRAM(TextColor);
        }
    }
    else
    {
        for(i = 0; i < Length; i++)
        {
            LCD_WriteRAM_Prepare(); /* Prepare to write GRAM */
            LCD_WriteRAM(TextColor);
            Xpos++;
            LCD_SetCursor(Xpos, Ypos);
        }
    }
}

/**
  * @brief  Displays a rectangle.
  * @param  Xpos: specifies the X position.
  * @param  Ypos: specifies the Y position.
  * @param  Height: display rectangle height.
  * @param  Width: display rectangle width.
  * @retval None
  */
void LCD_DrawRect(uint16_t Xpos, uint16_t Ypos, uint8_t Height, uint16_t Width)
{
    LCD_DrawLine(Xpos, Ypos, Width, LCD_DIR_HORIZONTAL);
    LCD_DrawLine((Xpos + Height), Ypos, Width, LCD_DIR_HORIZONTAL);

    LCD_DrawLine(Xpos, Ypos, Height, LCD_DIR_VERTICAL);
    LCD_DrawLine(Xpos, (Ypos - Width + 1), Height, LCD_DIR_VERTICAL);
}

/**
  * @brief  Displays a circle.
  * @param  Xpos: specifies the X position.
  * @param  Ypos: specifies the Y position.
  * @param  Radius
  * @retval None
  */
void LCD_DrawCircle(uint16_t Xpos, uint16_t Ypos, uint16_t Radius)
{
    int32_t  D;/* Decision Variable */
    uint32_t  CurX;/* Current X Value */
    uint32_t  CurY;/* Current Y Value */

    D = 3 - (Radius << 1);
    CurX = 0;
    CurY = Radius;

    while (CurX <= CurY)
    {
        LCD_SetCursor(Xpos + CurX, Ypos + CurY);
        LCD_WriteRAM_Prepare(); /* Prepare to write GRAM */
        LCD_WriteRAM(TextColor);
        LCD_SetCursor(Xpos + CurX, Ypos - CurY);
        LCD_WriteRAM_Prepare(); /* Prepare to write GRAM */
        LCD_WriteRAM(TextColor);
        LCD_SetCursor(Xpos - CurX, Ypos + CurY);
        LCD_WriteRAM_Prepare(); /* Prepare to write GRAM */
        LCD_WriteRAM(TextColor);
        LCD_SetCursor(Xpos - CurX, Ypos - CurY);
        LCD_WriteRAM_Prepare(); /* Prepare to write GRAM */
        LCD_WriteRAM(TextColor);
        LCD_SetCursor(Xpos + CurY, Ypos + CurX);
        LCD_WriteRAM_Prepare(); /* Prepare to write GRAM */
        LCD_WriteRAM(TextColor);
        LCD_SetCursor(Xpos + CurY, Ypos - CurX);
        LCD_WriteRAM_Prepare(); /* Prepare to write GRAM */
        LCD_WriteRAM(TextColor);
        LCD_SetCursor(Xpos - CurY, Ypos + CurX);
        LCD_WriteRAM_Prepare(); /* Prepare to write GRAM */
        LCD_WriteRAM(TextColor);
        LCD_SetCursor(Xpos - CurY, Ypos - CurX);
        LCD_WriteRAM_Prepare(); /* Prepare to write GRAM */
        LCD_WriteRAM(TextColor);
        if (D < 0)
        {
            D += (CurX << 2) + 6;
        }
        else
        {
            D += ((CurX - CurY) << 2) + 10;
            CurY--;
        }
        CurX++;
    }
}

/**
  * @brief  Displays a mono-color picture.
  * @param  Pict: pointer to the picture array.
  * @retval None
  */
void LCD_DrawMonoPict(const uint32_t *Pict)
{
    uint32_t index = 0, i = 0;
    LCD_SetCursor(0, (LCD_PIXEL_WIDTH - 1));
    LCD_WriteRAM_Prepare(); /* Prepare to write GRAM */
    for(index = 0; index < 2400; index++)
    {
        for(i = 0; i < 32; i++)
        {
            if((Pict[index] & (1 << i)) == 0x00)
            {
                LCD_WriteRAM(BackColor);
            }
            else
            {
                LCD_WriteRAM(TextColor);
            }
        }
    }
}

/**
  * @brief  Displays a bitmap picture loaded in the internal Flash.
  * @param  BmpAddress: Bmp picture address in the internal Flash.
  * @retval None
  */
void LCD_WriteBMP(uint32_t BmpAddress)
{
    uint32_t index = 0, size = 0;
    /* Read bitmap size */
    size = *(__IO uint16_t *) (BmpAddress + 2);
    size |= (*(__IO uint16_t *) (BmpAddress + 4)) << 16;
    /* Get bitmap data address offset */
    index = *(__IO uint16_t *) (BmpAddress + 10);
    index |= (*(__IO uint16_t *) (BmpAddress + 12)) << 16;
    size = (size - index)/2;
    BmpAddress += index;
    /* Set GRAM write direction and BGR = 1 */
    /* I/D=00 (Horizontal : decrement, Vertical : decrement) */
    /* AM=1 (address is updated in vertical writing direction) */
    LCD_WriteReg(LCD_REG_3, 0x1008);

    LCD_WriteRAM_Prepare();

    for(index = 0; index < size; index++)
    {
        LCD_WriteRAM(*(__IO uint16_t *)BmpAddress);
        BmpAddress += 2;
    }

    /* Set GRAM write direction and BGR = 1 */
    /* I/D = 01 (Horizontal : increment, Vertical : decrement) */
    /* AM = 1 (address is updated in vertical writing direction) */
    LCD_WriteReg(LCD_REG_3, 0x1018);
}

/**
  * @brief  Displays a full rectangle.
  * @param  Xpos: specifies the X position.
  * @param  Ypos: specifies the Y position.
  * @param  Height: rectangle height.
  * @param  Width: rectangle width.
  * @retval None
  */
void LCD_DrawFullRect(uint16_t Xpos, uint16_t Ypos, uint16_t Width, uint16_t Height)
{
    LCD_SetTextColor(TextColor);

    LCD_DrawLine(Xpos, Ypos, Width, LCD_DIR_HORIZONTAL);
    LCD_DrawLine((Xpos + Height), Ypos, Width, LCD_DIR_HORIZONTAL);

    LCD_DrawLine(Xpos, Ypos, Height, LCD_DIR_VERTICAL);
    LCD_DrawLine(Xpos, (Ypos - Width + 1), Height, LCD_DIR_VERTICAL);

    Width -= 2;
    Height--;
    Ypos--;

    LCD_SetTextColor(BackColor);

    while(Height--)
    {
        LCD_DrawLine(++Xpos, Ypos, Width, LCD_DIR_HORIZONTAL);
    }

    LCD_SetTextColor(TextColor);
}

/**
  * @brief  Displays a full circle.
  * @param  Xpos: specifies the X position.
  * @param  Ypos: specifies the Y position.
  * @param  Radius
  * @retval None
  */
void LCD_DrawFullCircle(uint16_t Xpos, uint16_t Ypos, uint16_t Radius)
{
    int32_t  D;    /* Decision Variable */
    uint32_t  CurX;/* Current X Value */
    uint32_t  CurY;/* Current Y Value */

    D = 3 - (Radius << 1);

    CurX = 0;
    CurY = Radius;

    LCD_SetTextColor(BackColor);

    while (CurX <= CurY)
    {
        if(CurY > 0)
        {
            LCD_DrawLine(Xpos - CurX, Ypos + CurY, 2*CurY, LCD_DIR_HORIZONTAL);
            LCD_DrawLine(Xpos + CurX, Ypos + CurY, 2*CurY, LCD_DIR_HORIZONTAL);
        }

        if(CurX > 0)
        {
            LCD_DrawLine(Xpos - CurY, Ypos + CurX, 2*CurX, LCD_DIR_HORIZONTAL);
            LCD_DrawLine(Xpos + CurY, Ypos + CurX, 2*CurX, LCD_DIR_HORIZONTAL);
        }
        if (D < 0)
        {
            D += (CurX << 2) + 6;
        }
        else
        {
            D += ((CurX - CurY) << 2) + 10;
            CurY--;
        }
        CurX++;
    }

    LCD_SetTextColor(TextColor);
    LCD_DrawCircle(Xpos, Ypos, Radius);
}

/**
  * @brief  Displays an uni-line (between two points).
  * @param  x1: specifies the point 1 x position.
  * @param  y1: specifies the point 1 y position.
  * @param  x2: specifies the point 2 x position.
  * @param  y2: specifies the point 2 y position.
  * @retval None
  */
void LCD_DrawUniLine(uint16_t x1, uint16_t y1, uint16_t x2, uint16_t y2)
{
    int16_t deltax = 0, deltay = 0, x = 0, y = 0, xinc1 = 0, xinc2 = 0,
            yinc1 = 0, yinc2 = 0, den = 0, num = 0, numadd = 0, numpixels = 0,
            curpixel = 0;

    deltax = ABS(x2 - x1);        /* The difference between the x's */
    deltay = ABS(y2 - y1);        /* The difference between the y's */
    x = x1;                       /* Start x off at the first pixel */
    y = y1;                       /* Start y off at the first pixel */

    if (x2 >= x1)                 /* The x-values are increasing */
    {
        xinc1 = 1;
        xinc2 = 1;
    }
    else                          /* The x-values are decreasing */
    {
        xinc1 = -1;
        xinc2 = -1;
    }

    if (y2 >= y1)                 /* The y-values are increasing */
    {
        yinc1 = 1;
        yinc2 = 1;
    }
    else                          /* The y-values are decreasing */
    {
        yinc1 = -1;
        yinc2 = -1;
    }

    if (deltax >= deltay)         /* There is at least one x-value for every y-value */
    {
        xinc1 = 0;                  /* Don't change the x when numerator >= denominator */
        yinc2 = 0;                  /* Don't change the y for every iteration */
        den = deltax;
        num = deltax / 2;
        numadd = deltay;
        numpixels = deltax;         /* There are more x-values than y-values */
    }
    else                          /* There is at least one y-value for every x-value */
    {
        xinc2 = 0;                  /* Don't change the x for every iteration */
        yinc1 = 0;                  /* Don't change the y when numerator >= denominator */
        den = deltay;
        num = deltay / 2;
        numadd = deltax;
        numpixels = deltay;         /* There are more y-values than x-values */
    }

    for (curpixel = 0; curpixel <= numpixels; curpixel++)
    {
        PutPixel(x, y);             /* Draw the current pixel */
        num += numadd;              /* Increase the numerator by the top of the fraction */
        if (num >= den)             /* Check if numerator >= denominator */
        {
            num -= den;               /* Calculate the new numerator value */
            x += xinc1;               /* Change the x as appropriate */
            y += yinc1;               /* Change the y as appropriate */
        }
        x += xinc2;                 /* Change the x as appropriate */
        y += yinc2;                 /* Change the y as appropriate */
    }
}

/**
  * @brief  Displays an poly-line (between many points).
  * @param  Points: pointer to the points array.
  * @param  PointCount: Number of points.
  * @retval None
  */
void LCD_PolyLine(pPoint Points, uint16_t PointCount)
{
    int16_t X = 0, Y = 0;

    if(PointCount < 2)
    {
        return;
    }

    while(--PointCount)
    {
        X = Points->X;
        Y = Points->Y;
        Points++;
        LCD_DrawUniLine(X, Y, Points->X, Points->Y);
    }
}

/**
  * @brief  Displays an relative poly-line (between many points).
  * @param  Points: pointer to the points array.
  * @param  PointCount: Number of points.
  * @param  Closed: specifies if the draw is closed or not.
  *           1: closed, 0 : not closed.
  * @retval None
  */
static void LCD_PolyLineRelativeClosed(pPoint Points, uint16_t PointCount, uint16_t Closed)
{
    int16_t X = 0, Y = 0;
    pPoint First = Points;

    if(PointCount < 2)
    {
        return;
    }
    X = Points->X;
    Y = Points->Y;
    while(--PointCount)
    {
        Points++;
        LCD_DrawUniLine(X, Y, X + Points->X, Y + Points->Y);
        X = X + Points->X;
        Y = Y + Points->Y;
    }
    if(Closed)
    {
        LCD_DrawUniLine(First->X, First->Y, X, Y);
    }
}

/**
  * @brief  Displays a closed poly-line (between many points).
  * @param  Points: pointer to the points array.
  * @param  PointCount: Number of points.
  * @retval None
  */
void LCD_ClosedPolyLine(pPoint Points, uint16_t PointCount)
{
    LCD_PolyLine(Points, PointCount);
    LCD_DrawUniLine(Points->X, Points->Y, (Points+PointCount-1)->X, (Points+PointCount-1)->Y);
}

/**
  * @brief  Displays a relative poly-line (between many points).
  * @param  Points: pointer to the points array.
  * @param  PointCount: Number of points.
  * @retval None
  */
void LCD_PolyLineRelative(pPoint Points, uint16_t PointCount)
{
    LCD_PolyLineRelativeClosed(Points, PointCount, 0);
}

/**
  * @brief  Displays a closed relative poly-line (between many points).
  * @param  Points: pointer to the points array.
  * @param  PointCount: Number of points.
  * @retval None
  */
void LCD_ClosedPolyLineRelative(pPoint Points, uint16_t PointCount)
{
    LCD_PolyLineRelativeClosed(Points, PointCount, 1);
}


/**
  * @brief  Displays a  full poly-line (between many points).
  * @param  Points: pointer to the points array.
  * @param  PointCount: Number of points.
  * @retval None
  */
void LCD_FillPolyLine(pPoint Points, uint16_t PointCount)
{
    /*  public-domain code by Darel Rex Finley, 2007 */
    uint16_t  nodes = 0, nodeX[MAX_POLY_CORNERS], pixelX = 0, pixelY = 0, i = 0,
              j = 0, swap = 0;
    uint16_t  IMAGE_LEFT = 0, IMAGE_RIGHT = 0, IMAGE_TOP = 0, IMAGE_BOTTOM = 0;

    IMAGE_LEFT = IMAGE_RIGHT = Points->X;
    IMAGE_TOP= IMAGE_BOTTOM = Points->Y;

    for(i = 1; i < PointCount; i++)
    {
        pixelX = POLY_X(i);
        if(pixelX < IMAGE_LEFT)
        {
            IMAGE_LEFT = pixelX;
        }
        if(pixelX > IMAGE_RIGHT)
        {
            IMAGE_RIGHT = pixelX;
        }

        pixelY = POLY_Y(i);
        if(pixelY < IMAGE_TOP)
        {
            IMAGE_TOP = pixelY;
        }
        if(pixelY > IMAGE_BOTTOM)
        {
            IMAGE_BOTTOM = pixelY;
        }
    }

    LCD_SetTextColor(BackColor);

    /*  Loop through the rows of the image. */
    for (pixelY = IMAGE_TOP; pixelY < IMAGE_BOTTOM; pixelY++)
    {
        /* Build a list of nodes. */
        nodes = 0;
        j = PointCount-1;

        for (i = 0; i < PointCount; i++)
        {
            if (((POLY_Y(i)<(double) pixelY) && (POLY_Y(j)>=(double) pixelY)) || \
                    ((POLY_Y(j)<(double) pixelY) && (POLY_Y(i)>=(double) pixelY)))
            {
                nodeX[nodes++]=(int) (POLY_X(i)+((pixelY-POLY_Y(i))*(POLY_X(j)-POLY_X(i)))/(POLY_Y(j)-POLY_Y(i)));
            }
            j = i;
        }

        /* Sort the nodes, via a simple "Bubble" sort. */
        i = 0;
        while (i < nodes-1)
        {
            if (nodeX[i]>nodeX[i+1])
            {
                swap = nodeX[i];
                nodeX[i] = nodeX[i+1];
                nodeX[i+1] = swap;
                if(i)
                {
                    i--;
                }
            }
            else
            {
                i++;
            }
        }

        /*  Fill the pixels between node pairs. */
        for (i = 0; i < nodes; i+=2)
        {
            if(nodeX[i] >= IMAGE_RIGHT)
            {
                break;
            }
            if(nodeX[i+1] > IMAGE_LEFT)
            {
                if (nodeX[i] < IMAGE_LEFT)
                {
                    nodeX[i]=IMAGE_LEFT;
                }
                if(nodeX[i+1] > IMAGE_RIGHT)
                {
                    nodeX[i+1] = IMAGE_RIGHT;
                }
                LCD_SetTextColor(BackColor);
                LCD_DrawLine(pixelY, nodeX[i+1], nodeX[i+1] - nodeX[i], LCD_DIR_HORIZONTAL);
                LCD_SetTextColor(TextColor);
                PutPixel(pixelY, nodeX[i+1]);
                PutPixel(pixelY, nodeX[i]);
                /* for (j=nodeX[i]; j<nodeX[i+1]; j++) PutPixel(j,pixelY); */
            }
        }
    }

    /* draw the edges */
    LCD_SetTextColor(TextColor);
}

/**
  * @brief  Writes to the selected LCD register.
  * @param  LCD_Reg: address of the selected register.
  * @param  LCD_RegValue: value to write to the selected register.
  * @retval None
  */
void LCD_WriteReg(uint8_t LCD_Reg, uint16_t LCD_RegValue)
{
    /* Write 16-bit Index, then Write Reg */
    LCD->LCD_REG = LCD_Reg;
    /* Write 16-bit Reg */
    LCD->LCD_RAM = LCD_RegValue;
}

/**
  * @brief  Reads the selected LCD Register.
  * @param  LCD_Reg: address of the selected register.
  * @retval LCD Register Value.
  */
uint16_t LCD_ReadReg(uint8_t LCD_Reg)
{
    /* Write 16-bit Index (then Read Reg) */
    LCD->LCD_REG = LCD_Reg;
    /* Read 16-bit Reg */
    return (LCD->LCD_RAM);
}

/**
  * @brief  Prepare to write to the LCD RAM.
  * @param  None
  * @retval None
  */
void LCD_WriteRAM_Prepare(void)
{
    LCD->LCD_REG = LCD_REG_34;
}

/**
  * @brief  Writes to the LCD RAM.
  * @param  RGB_Code: the pixel color in RGB mode (5-6-5).
  * @retval None
  */
void LCD_WriteRAM(uint16_t RGB_Code)
{
    /* Write 16-bit GRAM Reg */
    LCD->LCD_RAM = RGB_Code;
}

/**
  * @brief  Reads the LCD RAM.
  * @param  None
  * @retval LCD RAM Value.
  */
uint16_t LCD_ReadRAM(void)
{
    /* Write 16-bit Index (then Read Reg) */
    LCD->LCD_REG = LCD_REG_34; /* Select GRAM Reg */
    /* Read 16-bit Reg */
    return LCD->LCD_RAM;
}

/**
  * @brief  Power on the LCD.
  * @param  None
  * @retval None
  */
void LCD_PowerOn(void)
{
    /* Power On sequence ---------------------------------------------------------*/
    LCD_WriteReg(LCD_REG_16, 0x0000); /* SAP, BT[3:0], AP, DSTB, SLP, STB */
    LCD_WriteReg(LCD_REG_17, 0x0000); /* DC1[2:0], DC0[2:0], VC[2:0] */
    LCD_WriteReg(LCD_REG_18, 0x0000); /* VREG1OUT voltage */
    LCD_WriteReg(LCD_REG_19, 0x0000); /* VDV[4:0] for VCOM amplitude*/
    _delay_(20);                 /* Dis-charge capacitor power voltage (200ms) */
    LCD_WriteReg(LCD_REG_16, 0x17B0); /* SAP, BT[3:0], AP, DSTB, SLP, STB */
    LCD_WriteReg(LCD_REG_17, 0x0137); /* DC1[2:0], DC0[2:0], VC[2:0] */
    _delay_(5);                  /* Delay 50 ms */
    LCD_WriteReg(LCD_REG_18, 0x0139); /* VREG1OUT voltage */
    _delay_(5);                  /* Delay 50 ms */
    LCD_WriteReg(LCD_REG_19, 0x1d00); /* VDV[4:0] for VCOM amplitude */
    LCD_WriteReg(LCD_REG_41, 0x0013); /* VCM[4:0] for VCOMH */
    _delay_(5);                  /* Delay 50 ms */
    LCD_WriteReg(LCD_REG_7, 0x0173);  /* 262K color and display ON */
}

/**
  * @brief  Enables the Display.
  * @param  None
  * @retval None
  */
void LCD_DisplayOn(void)
{
    /* Display On */
    LCD_WriteReg(LCD_REG_7, 0x0173); /* 262K color and display ON */
}

/**
  * @brief  Disables the Display.
  * @param  None
  * @retval None
  */
void LCD_DisplayOff(void)
{
    /* Display Off */
    LCD_WriteReg(LCD_REG_7, 0x0);
}

/**
  * @brief  Configures LCD Control lines (FSMC Pins) in alternate function mode.
  * @param  None
  * @retval None
  */
void LCD_CtrlLinesConfig(void)
{
    GPIO_InitTypeDef GPIO_InitStructure;

    /* Enable GPIOD, GPIOE, GPIOF, GPIOG and AFIO clocks */
    RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOD | RCC_AHB1Periph_GPIOG | RCC_AHB1Periph_GPIOE |
                           RCC_AHB1Periph_GPIOF, ENABLE);

    GPIO_InitStructure.GPIO_Pin = GPIO_Pin_1 ;
    GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz ;
    GPIO_InitStructure.GPIO_Mode = GPIO_Mode_OUT;
    GPIO_Init(GPIOG, &GPIO_InitStructure);

    GPIO_ResetBits(GPIOG,GPIO_Pin_1);
    _delay_(5);
    GPIO_SetBits(GPIOG,GPIO_Pin_1);
    /*-- GPIO Configuration ------------------------------------------------------*/
    /* SRAM Data lines,  NOE and NWE configuration */
    GPIO_InitStructure.GPIO_Pin = GPIO_Pin_0 | GPIO_Pin_1 | GPIO_Pin_8 | GPIO_Pin_9 |
                                  GPIO_Pin_10 | GPIO_Pin_14 | GPIO_Pin_15 |
                                  GPIO_Pin_4 |GPIO_Pin_5;;
    GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF;
    GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
    GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;
    GPIO_InitStructure.GPIO_PuPd  = GPIO_PuPd_NOPULL;

    GPIO_Init(GPIOD, &GPIO_InitStructure);
    GPIO_PinAFConfig(GPIOD, GPIO_PinSource0, GPIO_AF_FSMC);
    GPIO_PinAFConfig(GPIOD, GPIO_PinSource1, GPIO_AF_FSMC);
    GPIO_PinAFConfig(GPIOD, GPIO_PinSource4, GPIO_AF_FSMC);
    GPIO_PinAFConfig(GPIOD, GPIO_PinSource5, GPIO_AF_FSMC);
    GPIO_PinAFConfig(GPIOD, GPIO_PinSource8, GPIO_AF_FSMC);
    GPIO_PinAFConfig(GPIOD, GPIO_PinSource9, GPIO_AF_FSMC);
    GPIO_PinAFConfig(GPIOD, GPIO_PinSource10, GPIO_AF_FSMC);
    GPIO_PinAFConfig(GPIOD, GPIO_PinSource14, GPIO_AF_FSMC);
    GPIO_PinAFConfig(GPIOD, GPIO_PinSource15, GPIO_AF_FSMC);

    GPIO_InitStructure.GPIO_Pin = GPIO_Pin_7 | GPIO_Pin_8 | GPIO_Pin_9 | GPIO_Pin_10 |
                                  GPIO_Pin_11 | GPIO_Pin_12 | GPIO_Pin_13 | GPIO_Pin_14 |
                                  GPIO_Pin_15;
    GPIO_Init(GPIOE, &GPIO_InitStructure);

    GPIO_PinAFConfig(GPIOE, GPIO_PinSource7 , GPIO_AF_FSMC);
    GPIO_PinAFConfig(GPIOE, GPIO_PinSource8 , GPIO_AF_FSMC);
    GPIO_PinAFConfig(GPIOE, GPIO_PinSource9 , GPIO_AF_FSMC);
    GPIO_PinAFConfig(GPIOE, GPIO_PinSource10 , GPIO_AF_FSMC);
    GPIO_PinAFConfig(GPIOE, GPIO_PinSource11 , GPIO_AF_FSMC);
    GPIO_PinAFConfig(GPIOE, GPIO_PinSource12 , GPIO_AF_FSMC);
    GPIO_PinAFConfig(GPIOE, GPIO_PinSource13 , GPIO_AF_FSMC);
    GPIO_PinAFConfig(GPIOE, GPIO_PinSource14 , GPIO_AF_FSMC);
    GPIO_PinAFConfig(GPIOE, GPIO_PinSource15 , GPIO_AF_FSMC);

    GPIO_WriteBit(GPIOE, GPIO_Pin_6, Bit_SET);
    /* SRAM Address lines configuration */
    GPIO_InitStructure.GPIO_Pin = GPIO_Pin_0;
    GPIO_Init(GPIOF, &GPIO_InitStructure);
    GPIO_PinAFConfig(GPIOF, GPIO_PinSource0, GPIO_AF_FSMC);

    /* NE3 configuration */
// GPIO_InitStructure.GPIO_Pin = GPIO_Pin_12|GPIO_Pin_1;

//  GPIO_Init(GPIOG, &GPIO_InitStructure);
//  GPIO_PinAFConfig(GPIOG, GPIO_PinSource12, GPIO_AF_FSMC);
//	GPIO_PinAFConfig(GPIOG, GPIO_PinSource1, GPIO_AF_FSMC);

    /* Set PF.00(A0 (RS)) as alternate function push pull */
//  GPIO_InitStructure.GPIO_Pin = GPIO_Pin_0;
//  GPIO_Init(GPIOF, &GPIO_InitStructure);
    /* Set PG.12(NE4 (LCD/CS)) as alternate function push pull - CE3(LCD /CS) */
    GPIO_InitStructure.GPIO_Pin = GPIO_Pin_12;
    GPIO_Init(GPIOG, &GPIO_InitStructure);
}

/**
  * @brief  Configures the Parallel interface (FSMC) for LCD(Parallel mode)
  * @param  None
  * @retval None
  */
void LCD_FSMCConfig(void)
{
    FSMC_NORSRAMInitTypeDef  FSMC_NORSRAMInitStructure;
    FSMC_NORSRAMTimingInitTypeDef  p;

    /* Enable FSMC clock */
    RCC_AHB3PeriphClockCmd(RCC_AHB3Periph_FSMC, ENABLE);

    /*-- FSMC Configuration ------------------------------------------------------*/
    /*----------------------- SRAM Bank 3 ----------------------------------------*/
    /* FSMC_Bank1_NORSRAM4 configuration */
    p.FSMC_AddressSetupTime = 5;
    p.FSMC_AddressHoldTime = 0;
    p.FSMC_DataSetupTime = 9;
    p.FSMC_BusTurnAroundDuration = 0;
    p.FSMC_CLKDivision = 0;
    p.FSMC_DataLatency = 0;
    p.FSMC_AccessMode = FSMC_AccessMode_A;
    /* Color LCD configuration ------------------------------------
       LCD configured as follow:
          - Data/Address MUX = Disable
          - Memory Type = SRAM
          - Data Width = 16bit
          - Write Operation = Enable
          - Extended Mode = Enable
          - Asynchronous Wait = Disable */

    FSMC_NORSRAMInitStructure.FSMC_Bank = FSMC_Bank1_NORSRAM3;
    FSMC_NORSRAMInitStructure.FSMC_DataAddressMux = FSMC_DataAddressMux_Disable;
    FSMC_NORSRAMInitStructure.FSMC_MemoryType = FSMC_MemoryType_SRAM;
    FSMC_NORSRAMInitStructure.FSMC_MemoryDataWidth = FSMC_MemoryDataWidth_16b;
    FSMC_NORSRAMInitStructure.FSMC_BurstAccessMode = FSMC_BurstAccessMode_Disable;
    FSMC_NORSRAMInitStructure.FSMC_AsynchronousWait = FSMC_AsynchronousWait_Disable;
    FSMC_NORSRAMInitStructure.FSMC_WaitSignalPolarity = FSMC_WaitSignalPolarity_Low;
    FSMC_NORSRAMInitStructure.FSMC_WrapMode = FSMC_WrapMode_Disable;
    FSMC_NORSRAMInitStructure.FSMC_WaitSignalActive = FSMC_WaitSignalActive_BeforeWaitState;
    FSMC_NORSRAMInitStructure.FSMC_WriteOperation = FSMC_WriteOperation_Enable;
    FSMC_NORSRAMInitStructure.FSMC_WaitSignal = FSMC_WaitSignal_Disable;
    FSMC_NORSRAMInitStructure.FSMC_ExtendedMode = FSMC_ExtendedMode_Disable;
    FSMC_NORSRAMInitStructure.FSMC_WriteBurst = FSMC_WriteBurst_Disable;
    FSMC_NORSRAMInitStructure.FSMC_ReadWriteTimingStruct = &p;
    FSMC_NORSRAMInitStructure.FSMC_WriteTimingStruct = &p;

    FSMC_NORSRAMInit(&FSMC_NORSRAMInitStructure);

    /* Enable FSMC NOR/SRAM Bank3 */
    FSMC_NORSRAMCmd(FSMC_Bank1_NORSRAM3, ENABLE);
}

/**
  * @brief  Displays a pixel.
  * @param  x: pixel x.
  * @param  y: pixel y.
  * @retval None
  */
static void PutPixel(int16_t x, int16_t y)
{
    if(x < 0 || x > 239 || y < 0 || y > 319)
    {
        return;
    }
    LCD_DrawLine(x, y, 1, LCD_DIR_HORIZONTAL);
}


#ifndef USE_Delay
/**
  * @brief  Inserts a delay time.
  * @param  nCount: specifies the delay time length.
  * @retval None
  */
static void delay(__IO uint32_t nCount)
{
    __IO uint32_t index = 0;
    for(index = (100000 * nCount); index != 0; index--)
    {
        ;
    }
}
#endif /* USE_Delay*/

/**
  * @brief  Plot BMP.
  * @param  uint16_t pBufferImage pointer to the BMP buffer;
  * @param  uint16_t Xpos orizontal position of the top left point of the BMP
  * @param  uint16_t Ypos vertical position of the top left point of the BMP
  * @param  uint16_t Width width of BMP expressed in pixel
  * @param  uint16_t Height heigth of BMP expressed in pixel
  * @retval None
  */
void LCD_PlotBMP(uint16_t *pBufferImage, uint16_t Xpos, uint16_t Ypos, uint16_t Width, uint16_t Height)
{
    uint32_t index = 0, i = 0;
    uint16_t Xaddress = Ypos + Height;
    uint16_t Yaddress = LCD_PIXEL_WIDTH - 1 - Xpos;

    LCD_SetCursor(Xaddress, Yaddress);

    for(index = 0; index < Height; index++)
    {
        LCD_WriteReg(LCD_REG_3, 0x1008);
        LCD_WriteRAM_Prepare();

        for(i = 0; i < Width; i++)
        {
            LCD_WriteRAM(pBufferImage[i + index * Width]);
        }

        LCD_WriteReg(LCD_REG_3, 0x1018);

        Xaddress--;
        LCD_SetCursor(Xaddress, Yaddress);
    }
}

/**
  * @brief  Draws a character on LCD.
  * @param  Xpos: the Line where to display the character shape.
  * @param  Ypos: start column address.
  * @param  c: pointer to the character data.
  * @retval None
  */
void LCD_DrawCharHorizontal(uint8_t Xpos, uint16_t Ypos, const uint16_t *c)
{
    uint8_t index = 0, i = 0;
    uint8_t Xaddress = 0;
    uint16_t LocTextColor = 0, LocBackColor = 0;

    LCD_GetColors(&LocTextColor, &LocBackColor);

    Xaddress = Xpos;

    LCD_SetCursor(Xaddress, Ypos);

    for(index = 0; index < LCD_GetFont()->Height; index++)
    {

        LCD_WriteRAM_Prepare(); /* Prepare to write GRAM */
        for(i = 0; i <  LCD_GetFont()->Width; i++)
        {
            if(!(c[i] & (0x1 << index)))
            {
                LCD_WriteRAM(LocBackColor);
            }
            else
            {
                LCD_WriteRAM(LocTextColor);
            }
        }
        Xaddress++;
        LCD_SetCursor(Xaddress, Ypos);
    }
}

LCD_x_axes_t LCD_GetXAxesDirection(void)
{
    return LCD_X_AXES_INVERTED;
}

/**
  * @}
  */

/**
  * @}
  */

/**
  * @}
  */

/**
  * @}
  */

/**
  * @}
  */

/******************* (C) COPYRIGHT 2011 STMicroelectronics *****END OF FILE****/
